
//modificado
#define Esq_FT 1 // controle da esquerda, pot frente-tras na analog 0
#define Esq_DE 3
#define Dir_FT 2
#define Dir_DE 4



// ORIGINAL ABAIXO
// O da esquerda eh o "mole"
#define Esq_FT 0 // controle da esquerda, pot frente-tras na analog 0
#define Esq_DE 2
#define Dir_FT 1
#define Dir_DE 3


// Valores analogicos do joystick

// controle esquerdo
#define ce_frente 411
#define ce_centroFT 724
#define ce_tras 840

#define ce_esq 487
#define ce_centroDE 761
#define ce_dir 856

//controle direito

#define cd_frente 847
#define cd_centroFT 757
#define cd_tras 190

#define cd_esq 260
#define cd_centroDE 690
#define cd_dir 838




int potPin = 2;



void setup()
{
  Serial.begin(19200);
  pinMode(14,OUTPUT);
  digitalWrite(14,LOW);
}

void loop()
{
  int valorCE_FT = 0;
  int valorCE_DE = 0;
  int valorCD_FT = 0;
  int valorCD_DE = 0;
  
  // esses eps tem q ser melhor estimados
  int eps1 = 50; 
  int eps2 = 50;
  int eps3 = 50;
  int eps4 = 50;
  
  valorCE_FT = analogRead(Esq_FT);
  valorCE_DE = analogRead(Esq_DE);
  valorCD_FT = analogRead(Dir_FT);
  valorCD_DE = analogRead(Dir_DE);
  
  Serial.println(valorCE_FT);
  Serial.println(valorCE_DE);
  Serial.println(valorCD_FT);
  Serial.println(valorCD_DE);
  
 /* 
  if( (valorCE_FT < ce_frente + eps1) && (valorCE_FT > ce_frente - eps1) )
    //frente();
    Serial.println("frente");
  else
    if( (valorCE_FT < ce_tras + eps2) && (valorCE_FT > ce_tras - eps2) )
      //tras();
      Serial.println("tras");
    else  
      if( (valorCE_DE < ce_dir + eps3) && (valorCE_DE > ce_dir - eps3) )
        //direita();
        Serial.println("direita");
    else
      if( (valorCE_DE < ce_esq + eps4) && (valorCE_DE > ce_esq - eps4) )
        //esquerda();
        Serial.println("esquerda");
      else
        Serial.println("parado"); */
  
  
  delay(500);
   
  
}
